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摘 要 : 针对 无 人 直升机 模型 复杂 ， 控 制 器 难于 设计 ， 易 受 外 界 干扰 等 问题 ， 在 建立 亚 拓 系 列 直 升 机 动力 学 模型 基础 
上 ， 提 出 了 一 种 改进 的 二 阶 线性 自 抗 扰 控制 器 。 首 先 ， 将 线性 扩张 状态 观测 器 用 于 估计 影响 输出 结果 的 扰动 ， 并 加 入 
跟踪 微分 器 。 然 后 ， 改 进 了 控制 器 结构 与 反馈 补偿 系数 ， 使 直升机 姿态 角 能 够 更 快 地 响应 所 输入 的 指令 ， 并 能 够 按 设 
定 的 角度 飞行 ， 以 完成 要 求 的 任务 ; 最 后 ， 通 过 引入 白 噪 声 干扰 模块 ， 来 验证 本 文 控制 器 的 抗 干扰 能 力 。 对 比 仿真 结 
果 表 明 ， 本 文 所 提出 的 控制 器 对 于 无 人 直升机 的 姿态 角 有 和 较 好 的 控制 效果 ， 优 于 其 他 两 种 控制 器 。 特 别 是 在 噪声 干扰 
的 条 件 下 ， 也 有 较 好 的 动态 性 能 和 鲁 棒 性 。 
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Research on attitude control method of unmanned helicopter based on 
linear active disturbance rejection control 
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Abstract: In order to solve the problems of complex model of unmannedhelicopter difficulty of flight controller design and 
susceptible to external disturbances, this paper establish a kinetic model of Trex series helicopters and propose an improved 
second order linear active disturbance rejection controller. First, use the LADRC to estimate the disturbance that affects the 
output and add the tracking differentiator at the same time. Secondly, improve the controller structure and the feedback 
compensation coefficient, so that the helicopter attitude angle can respond to the input command more quickly, and can fly at a 
set angle to accomplish the required tasks; Finally, introduce the white noise interference module to verify the anti jamming 
ability of the controller. Comparative simulation results show that the controller in this paper has better control effect on the 
attitude angle of the unmanned helicopter. It is better than the other two controllers. Especially in the condition of noise 
interference, it also has better dynamic performance and robustness. 
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升 机 操控 手 带 来 很 大 的 困难 ， 也 给 直升机 飞行 控制 器 的 设计 带 

来 了 巨大 挑战 ， 所 以 设计 一 个 能 够 使 直升机 快速 动作 及 有 效 避 
随 着 经 济 水 平 的 提升 ， 以 及 科学 技术 的 发 展 ， 各 国 在 战场  ” 免 外 界 干扰 影响 的 控制 器 ， 不 仅 符合 今日 军事 战场 上 的 急切 需 
上 使 用 的 武器 也 越 来 越 智 能 化 止 。 而 旋转 辟 直 升 机 ， 特 别 是 无 求 ， 也 是 民事 应 用 中 的 安全 保障 。 
人 直升机 ， 以 其 对 空间 场地 要 求 小 、 方 向 与 速度 易 控 制 及 安全 对 于 直升机 跟踪 控制 器 的 设计 ， 国 内 外 学 者 都 取得 了 很 多 
性 高 的 特点 , 在 军事 上 的 运用 达到 了 前 所 未 有 的 热度 外 ,然而 ， 的 成 果 。 文 献 [6] 设 计 了 一 种 自 适 应 反 步 法 控制 器 ， 通 过 非 线性 
直升机 作为 一 个 多 输入 多 输出 的 非 线 性 系统 ， 具 有 强 耦 合 性 的 自 适应 律 来 估计 直升机 所 受到 的 各 种 干扰 ， 然 后 将 干扰 值 整合 
六 自由 度 刚 体 B5, 在 执行 任务 时 对 其 的 反映 时 间 及 飞行 的 稳定 。 至 反 步 法 控制 器 中 ， 对 干扰 有 着 较 好 的 控制 ， 但 在 干扰 频率 较 
性 要 求 较 高 。 此 外 ， 直 升 机 极 易 受到 外 界 的 干扰 ， 这 不 但 给 直 ”高 环境 下 的 控制 效果 略 显 差强人意 ; 文献 [7] 提 出 了 一 种 小 型 无 
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人 直升机 的 模型 预测 控制 轨迹 跟踪 (MPCTT) 系 统 ， 跟 踪 的 响应 
时 间 快 ， 效 果 好 ， 不 过 在 直升机 遇 到 干扰 情况 下 的 控制 效果 ， 
没有 做 详细 的 验证 ;文献 [8-9] 建 立 直升机 模型 的 仿 射 非 线 性 
方程 组 ， 对 建立 的 仿 射 非 线 性 方程 设计 自 适 应 模糊 滑 模 控制 器 
(AFSMC)， 不 过 在 控制 中 ， 仿 射出 的 直升机 模型 较 原 模型 还 是 
有 一 定 区 别 的 ， 而 对 于 直升机 这 类 多 输入 多 输出 的 复杂 六 自 
度 系统 ， 前 述 的 控制 器 对 通道 之 间 的 交叉 耦合 是 难以 消除 的 ， 
且 对 于 外 界 的 干扰 也 没有 较 好 的 控制 ， 故 文献 [10~12] 提 出 了 
自 抗 扰 控制 器 (ADRC), 可 以 不 依赖 于 被 控 对 象 本 身 的 具体 模型 ， 
通过 状态 观测 器 预测 影响 系统 输出 的 扰动 ， 然 后 对 系统 实施 补 
类 以 达到 控制 的 效果 ;文献 [13~15] 在 自 抗 扰 控 制 器 的 基础 上 ， 
提出 线性 自 抗 扰 控制 器 (LADRC)， 算 法 简单 易 实现 ， 需 要 调整 
的 参数 较 少 ， 不 但 有 很 好 的 跟踪 效果 ， 而 且 还 有 一 定 的 抗 干扰 
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为 了 加 快 姿态 角 的 响应 速度 ， 实 现 姿态 角 的 稳定 控制 及 提 
高 直升机 的 抗 干扰 能 力 ， 以 满足 直升机 在 执行 任务 时 对 实时 性 
与 准确 性 的 要 求 , 本 文 在 文献 [16] 的 基础 上 , 采用 线性 扩张 状态 
观测 器 ， 加 入 跟踪 微分 器 ， 并 改进 线性 自 抗 扰 控制 器 的 结构 与 
反馈 补偿 系数 ， 对 亚 拓 600 直升机 的 姿态 角 进 行 控 制 ， 通 过 对 
比分 析 文 献 [16] 中 控制 系统 、 模 糊 自 整定 PID( 简 称 模糊 PID) 控 
制 系统 与 本 文 控制 系统 的 仿真 实验 结果 ， 发 现 改 进 后 的 控制 器 
响应 时 间 更 快 ， 跟 踪 误 差 更 小 ， 并 通过 噪声 干扰 模块 验证 本 文 
空 制 器 的 抗 扰 动能 


1 “无 人 直升机 的 飞行 动力 学 模型 


1.1 主 旋 翼 模型 

主 旋 姻 作为 无 人 直升机 最 关键 的 部 位 ， 既 可 以 通过 旋转 产 
生 上 升 的 升力 ， 又 可 以 操纵 直升机 ， 使 其 产生 做 俯仰 ， 升 降 ， 
横 滚 等 运动 所 需要 的 力 与 力矩 ， 从 而 操控 直升机 向 各 个 方向 运 
动 。 本 文 假定 直升机 的 桨 叶 为 刚体 薄片 、 旋 器 旋转 时 速度 保持 
恒定 不 变 、 把 旋 必 的 入 流 角 与 挥舞 角 近 似 于 小 角度 使 用 ， 且 名 
略 空气 压缩 性 及 奖 叶 失速 的 影响 。 则 垂直 上 升 飞行 时 主 旋 翼 的 
升力 为 


7,= CPS, QR) (1) 
其 中 : C7 为 主 旋 翼 拉力 系数 ，p 为 空气 密度 ，R; 为 主 旋 翼 半 
径 ，5, =XxR; 为 桨 盘面 积 ，9; 为 主 旋 姻 旋转 角速度 。 
将 主 旋 翼 的 拉力 分 解 到 x 、y 、z 三 个 坐标 轴 上 ， 即 可 得 
到 直升机 在 、y、7z 三 坐标 轴 上 的 作用 力 ， 这 三 个 作用 力 可 
表示 为 


Xjy= -Tar Y=Tb» Zs=T, (2) 
此 可 以 得 到 主 旋 翼 的 滚 转 力矩 六、 俯仰 力矩 W sy 及 偏 航 
力矩 Nj 的 表达 式 为 


L,=(K, +T,h)b, 
M,= (Ky +T,h)a, G3) 
N, = CpR'(Q,RY 


其 中 :，C? 为 旋翼 反 扭 矩 系数 ，w ，b, 分 别 为 主 旋 经 的 纵 ， 横 


向 挥舞 角 。 
1.2 尾 奖 模型 
尾 浆 旋转 时 产生 的 拉力 为 

7 =]J2CpmRy (QR,,) (4) 
其 中 :Cr 为 尾 桨 拉力 系数 ，92,; 为 尾 桨 旋转 角速度 ，Rv 为 
桨 半径 。 
尾 奖 旋转 时 产生 的 偏 航 力矩 与 深 转 力矩 分 别 为 

Ns; = -Yh Dy = Yh (5) 
其 中 : 4 ，h 分别 为 尾 桨 旋转 轴 中 心 到 机 体重 心 的 水 平 距离 
与 垂 向 距离 。 
1.3 平 尾 和 垂 尾 模型 

直升机 的 平 尾 即 水 平安 定 面 ， 安 装 于 尾 杆 上 ， 在 直升机 飞 

行 时 ， 为 其 提供 俯仰 通道 上 的 阻尼 ， 并 对 俯仰 的 稳定 起 到 一 定 
的 作用 。 平 尾 的 受 力 为 


是 


1 
Zp = 5 pS pw 


其 中 : Sm 为 平 尾 面 积 ，C 为 平 尾 升力 系数 ，w, 为 平 尾 的 垂 
向 速度 。 则 平 尾 产 生 的 俯仰 力矩 为 
M mv = Z pi pk (7) 
直升机 的 垂 尾 即 垂直 安定 面 ， 安 装 于 尾 浆 附近， 为 直升机 
提供 侧 向 拉力 ， 以 增加 直升机 的 航向 阻尼 ， 并 对 航向 的 稳定 起 
到 一 定 的 作用 。 则 垂 尾 的 侧 向 力 为 
Y= -1/2pS,,(Cr' YY， 十 


pw 
(C: lus| ww + |w 


wm) (0) 


Vv, 


Ww vo, (8) 


其 中 : VY* = JG +w, ) ，S6 为 垂 尾 的 面积 ， 


cw 


Cr 为 垂 尾 的 升 


力 系 数 ，ve 为 垂 尾 相对 于 空气 运动 时 的 侧 向 速度 。 
E 尾 作用 时 产生 的 滚 转 力矩 与 偏 豚 力矩 分 别 为 
L,= Yh No,= Yo, (9) 
其 中 :  ， 凡 ,分 别 为 尾 桨 中 心 到 机 体质 心 的 水 平 距离 与 垂 向 
距离 。 
1.4 机 身 模型 
机 身 的 空气 动力 在 x ，y ，z 三 坐标 轴 上 的 分 量 可 表示 为 


上山 


J 


1 js 2 
X= CoV Sj 


| 
Y= 3CIpV’S, (10) 


Z, = 7 CpV’S, 
其 中 :CY ，Cw ，CY 分 别 为 机 身 沿 三 个 坐标 轴 方向 上 分 力 的 
气动 系数 , V 为 机 体 相 对 于 空气 飞行 的 合 速度 ，3; 为 机 身 的 
效 迎 面 面 积 。 
机 体 在 x 、y、 


zx 三 坐标 轴 上 的 力矩 分 量 可 表示 为 


1 js 
Ls=3CEPV Sasa + AL, 


js 


1 
Mi = CupV Sal + AM; (1 


A A 


| 
Na = CHPV'S I 


让 万 


+AN, 
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其 中 : CX ，CY ，C# 分 别 为 机 体 气 动力 对 机 体 本 身 的 重心 构成 

的 横 滚 力矩 系数 、 俯 仰 力矩 系数 与 偏 航 力矩 系数 ，/i; 为 机 身 总 

长 度 ，4L，4M ;,，4N; 分 别 为 绕 对 应 机 体 轴 的 修正 力矩 。 

1.5 机 体 的 合力 与 合力 矩 

直升机 的 重力 在 x ，》 ，z 三 个 坐标 轴 上 的 分 力 表示 为 
Xs,=—mgsing 


Y=—mgsingcos0 (12) 


Ze = —mgcosgcos0 


其 中 : m 为 直升机 的 总 质量 。 则 在 机 体 坐 标 系 下 , 直升机 的 合力 
与 合力 矩 表示 为 
| 六 Xe X J X wj X pw 和 X 省 
5 = La Y, Y, Y, pw 也， Y. 
天 Ze 2, 2 pw 2 Ww Z js 
(13) 
L L, 了 L,, L,, L js 
Ms 一 M M a M wi M,, MI M; 
N Ni Ni N pw Na N Js 


1.6 全 机 的 动力 学 模型 
将 牛顿 第 二 定律 =ma 与 以 上 的 结论 相 结 合 分 析 , 则 直 升 
机 的 动力 学 方程 为 


V=F,/m-WxV 


W=7"[M; —W x(W)] (14) 
六 = EW 
直升机 机 体 坐 标 系 的 外 力矩 作用 下 的 角 运 动 方程 为 
L| [1p 
M;=|M |=| 1,6 |+WxUW) (15) 
N| |I7 


其 中 :V 为 线 速度 ，W 为 角速度 ，) 为 姿态 角 ，E 为 角速度 转换 
到 欧 拉 角速度 的 转换 矩阵 ， 了 为 转动 惯量 矩阵 ， 且 
V=[u v wl, W=[p gq 7, y=[pg 0 wr (10) 
此 可 得 ， 直 升 机 的 非 线性 动力 学 方程 为 


vr— wgq— gsinn + > 有 fm | 
—ur + wp + gcosQsing + > Bs m 
ugq — vp + gcosbcosp + > 忆 / m 
dr )/ Le + E11 
=| wp — Lx yy 二 zm/1,y, (17) 
pa — Tyy )/ Ts + TN/ 
p+(gsing+ rcosg)tang 


gcosg 一 rsing 


(qsing + rcosg)secO 


EE. VD. hp YN RY a <. 


根据 所 建立 的 直升机 的 非 线性 模型 ， 采 用 小 扰动 法 进行 线 
性 化 ， 即 在 直升机 的 飞行 平衡 点 处 将 其 运动 方程 按 Taylor 级 数 
展开 ， 并 忽略 二 级 及 更 高 阶 的 导数 ， 然 后 将 直升机 运动 状态 下 
的 各 个 参量 表示 为 基准 状态 下 的 值 加 上 一 个 小 扰动 增 量 051， 该 
方法 使 用 起 来 较为 简略 ， 此 处 便 不 再 资 述 。 由 此 方法 可 得 直 升 
机 在 机 体 轴 系 下 的 增 量 线性 状态 方程 


ChinaXiv 合 作 期 刊 


i 
王 云 霞 ， 等 : 一 种 线性 自 抗 扰 控 制 器 的 无 人 直升机 姿态 控制 方法 研究 


AX = 44X + BA6 (18) 


其 中 : 4X=[4u 4y A 人 w Lp hq rho 40 hy a bl] 


45=[46, 45, 46 A460] 


此 可 得 到 直升机 的 增 量 运动 方程 ， 将 其 写成 状态 空间 方 
程 的 形式 ， 便 可 得 到 系统 矩阵 4 与 输入 矩阵 BB， 式 中 的 46% 、 
40。、40w 和 405。 分 别 表示 旋翼 横向 周期 变 距 、 纵 向 周期 变 
距 、 尾 奖 总 距 和 主 旋 辟 总 距 。 其 中 参照 文献 [17] 中 亚 拓 600 直 
升 机 的 各 个 参数 ， 并 将 对 应 的 参数 代入 到 矩阵 A 和 甜 阵 BB 中 ， 
便 得 到 了 亚 拓 600 直升机 悬 停 状态 下 的 线性 化 模型 。 


2 ”改进 线性 自 抗 扰 控制 器 的 设计 


线性 自 抗 扰 控制 LADRC) 不 考虑 系统 内 部 的 具体 结构 ， 通 
过 跟踪 微分 器 来 获得 微分 信号 ， 并 实现 过 渡 过 程 的 配置 ， 通 过 
线性 状态 观测 器 (LESO) 来 估计 出 实时 系统 的 状态 及 扰动 信息 ， 
预测 系统 的 不 确定 性 ， 即 系统 的 内 外 扰动 及 模型 的 误差 等 ， 然 
后 对 误差 系统 进行 反馈 补偿 , 相对 于 ADRC 所 需 调节 的 参数 更 


/> 


SS 


本 文 所 设计 的 控制 器 采用 二 阶 LADRC， 主 要 模块 是 跟踪 
微分 器 (tracking differentiator-TD) 和 线性 扩张 状态 观测 器 (linear 
extended state observer-LESO) 两 部 分 , 结构 简单 易 懂 , 算法 清晰 
明了 ,有 跟踪 微分 器 中 的 参数 7 ,h ,T ,线性 扩张 状态 观测 器 的 
中 的 参数 w,，b,。 ， 及 反馈 补偿 回路 中 的 参数 w, , w. ,ky 共有 了 七 
个 参数 需要 整定 。 本 控制 器 相对 于 文献 [16] 加 入 了 跟踪 微分 器 ， 
设计 了 控制 器 的 新 结构 ， 改 进 了 反馈 补偿 系数 。 改 进 后 的 控制 
器 内 部 结构 如 图 1 所 示 ， 其 中 1n_y 为 输入 姿态 角 的 目标 值 ， 
ZAM 为 直升机 的 输入 通道 参量 ，y 为 姿态 角 反 馈 量 。 
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妈 1 改进 LADRC 的 结构 原理 图 


2.1 跟踪 微分 器 (TD) 
跟踪 微分 器 为 控制 器 安排 过 渡 过 程 。 其 离散 表达 式 为 

XkK+D)=X,(k)+TX,(k) 

XkK+D)= X,(k) + Tfhan(X,(R),X,(K),u(k),r,h) 0 
其 中 : X,(K+7)，X,(k+7) 为 跟踪 微分 器 的 两 个 输出 量 ， 且 分 别 
跟踪 输入 值 In_y 的 值 与 In_y 的 微分 值 ，7 为 采样 周期 ，r 决定 
跟踪 速度 的 快慢 ，hh 对 扰动 有 一 定 的 滤波 效果 ， 增 大 该 值 可 以 
更 好 地 抑制 误差 。fhan 函数 为 自 抗 扰 控制 技术 中 常用 的 非 线性 
函数 , 该 函数 的 表达 式 如 (20) 所 示 , 并 通过 编写 三 个 通道 的 S 函 
数 来 建立 跟踪 微分 器 的 函数 模块 。 
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Y= X,+hX, =8.2, hy=1.06, T,=1.236; 1, =0.01, h, =3.96 , T, =1.492 ， 

d=rh 将 改进 前 的 LADRC、 改 进 后 的 LADRC 与 模糊 PID 控制 三 控 

d=hd 制 器 的 输出 结果 作对 比 。 首 先 给 p ， 0 ，w 三 个 姿态 角 分 别 

m= Vd +8rl?| 输入 常量 1”, 3”, 5”, 分 别 得 到 图 3-5, 通过 对 比 可 以 看 出 ， 

X, + (0) sign(y), Ya, ee 对 于 9 角 的 控制 ， 改 进 前 的 控制 器 虽然 也 有 不 错 的 控制 效果 ， 

a= 本 但 姿态 角 的 响应 时 间 相 对 于 改进 后 的 略 慢 ， 虽 然 改进 后 的 姿态 

2 + 太 ， Ysa, 角 波形 波动 略 大 ， 但 超 调 量 较 低 ， 这 对 整体 系统 不 会 产生 不 良 

—rsign(a), lal>4a 的 影响 ， 而 模糊 PID 控制 器 达到 稳定 值 的 时 间 相 对 较 慢 ， 而 且 

Wan a a 在 靠近 目标 值 前 有 一 定 的 波动 ， 对 于 0 ，w 两 个 角度 通道 ， 改 

进 后 的 控制 器 比 改 进 前 及 模糊 PID 控制 器 的 响应 时 间 更 快 ， 一 

2.2 线性 扩张 状态 观测 器 (LESO) 般 在 2s-4s 之 间 就 可 以 达到 并 稳定 在 目标 值 ， 而 改进 前 及 模糊 
由 上 章 所 建 直 升 机 的 姿态 角 模型 分 析 可 知 ， 对 于 姿态 角 的 。 PID 控制 器 则 一 般 在 5s 及 以 后 才能 达到 稳定 , 这 对 于 直升机 在 
运动 可 用 二 阶 微分 方程 表达 ， 故 在 控制 器 中 可 采用 二 阶 线性 扩 ”做 任务 的 过 程 中 ， 本 文 控制 器 对 其 时 效 性 的 要 求 能 够 得 到 更 好 


张 状态 观测 器 1， 其 表达 式 为 的 满足 。 
为 三 号 三 0 人 二 
a bo : Boy ji 滚 转角 gq 仿真 效果 对 比 图 
= bret Boyt bu QD en 
14T5r 一 -一 - 模糊 PID 控 制 
z=—poszi + Bosy 


该 方程 的 特征 方程 为 + fos + pws+pos， 为 了 更 好 地 预 


测 对 象 的 状态 与 “总 和 扰动 "将 特征 方程 式 配置 成 (s+w,) 的 


形式 ， 即 参数 fo, ，pos ， po 分 别 赋值 为 3w, ，3w,”，w,”，w 
为 观测 器 的 带宽 ， 由 此 可 知 ，LESO 仅 有 w, 和 2b, 两 个 参数 需 弛 
整定 。 则 观测 器 的 状态 空间 方程 为 
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图 3 三 控制 器 对 深 转 角 $ 的 控制 效果 对 比 区 


多 -3w, 71 0lz, 0 3w, 


l= 3w 0 Tz ltlp 3w 四 CO2) 
| —3wW 0 0 0 3w 俯仰 角 6 仿 真 效果 对 比 图 es 
3 ”仿真 实验 与 结果 分 析 
在 上 章 设计 的 控制 器 的 基础 上 ， 在 MATLAB/Simulink 环 3 ) 
境 下 搭建 亚 拓 600 直升机 模型 及 控制 仿真 系统 ， 整 体 模型 如 图 “| | 
2 所 示 。Iny 为 输入 姿态 角 的 目标 值 , LADRC 将 控制 的 结果 通 昌国 天 六 
过 舵 机 输入 直升机 模型 中 ， 从 i 而 得 到 直 升 机 的 运动 姿态 角 y， "0 2 4 Ee 8 和 16 18 20 
然后 将 姿态 角 反 馈 至 控制 器 中 ， 与 目标 输入 值 作 比较 并 得 到 两 


司 4 三 控制 器 对 俯仰 角 9 的 控制 效果 对 比 图 


者 的 误差 值 ， 通 过 观测 器 来 估计 出 该 误差 ， 最 后 对 误差 进行 补 
偿 控 制 从 而 减 小 误差 ， 其 中 了 为 直升机 飞行 时 受到 的 外 界 扰动 。 


偏 航 角 由 仿真 效果 对 比 图 


改进 前 的 LADRC 控 制 
一 一 改进 后 的 LADRC 控 制 


7 模糊 PID 控 制 
f 
7 i 无 人 直 
LADRC [CO 能 机 3 | 升 机 模 人 
二 和 型 


h 1 1 | 
8 10 12 14 16 18 20 


图 2 直升机 姿态 角 跟 踪 的 结构 区 
图 5 三 控制 器 对 偏 航 角 的 控制 效果 对 比 图 


3.1 三 控制 器 控制 效果 对 比 
首先 ,在 输入 扰动 了 =0 时 , 给 三 个 姿态 角 通道 设 定 不 同 的 为 了 更 好 地 验证 本 文 控制 方法 的 控制 效果 ， 保 持 之 前 所 有 
跟踪 微分 器 的 参数 值 , 分 别 为 =0.011, 有 y=12.663 , 6=0.2 ， 参数 不 变 ， 在 此 基础 上 给 三 姿态 角 输 入 方 波 信号 ， 将 该 模块 的 


录用 稿 


参数 设 


为 : 延迟 时 间 为 5, 周 


期 为 50, 幅 值 为 5, 脉 宽 为 15， 


通过 对 比 三 个 探 人 


判 器 控制 下 的 三 姿态 角 响 应 


线 及 误差 响应 


线 , 得 到 


6-7， 从 仿真 对 比 图 中 可 以 看 出 , 三 种 控制 器 对 于 输 


入 的 方 波 都 会 产 9 
的 姿态 角 能 够 更 快 、 更 准确 地 完成 指定 的 方 波 响应 动作 。 通 过 
对 比方 波 响应 的 误差 图 可 以 发 现 ， 


E 相 应 的 响应 ， 但 改进 后 的 LADRC 使 直升机 


三 控制 器 在 响 上 都 有 


em 


速度 


一 定 的 延 时 ， 不 过 改进 后 的 LADRC 在 三 个 姿态 角 通 道 ] 


上 的 控 


制 误差 最 小 ， 误 差 持 续 的 时 间 也 最 短 。 经 上 述 对 比分 析 ， 


改进 


后 的 LADRC 的 直升机 姿态 角 控 制 效果 要 优 于 改进 前 的 


LADRC 及 模糊 PID 控制 器 的 控制 效果 。 


输入 方 波 时 滚 转角 9 仿真 效果 对 比 图 


5 10 15 20 
时 间 /s 


输入 方 波 时 俯仰 角 9 仿 真 效 果 对 比 图 


5 10 15 20 
时 间 /s 


输入 方 波 时 偏 航 角 由 仿真 效果 对 比 图 


三 控制 器 在 输入 方 波 时 姿态 角 响 应 曲线 


姿态 角 /* 
口 


输入 方 波 时 深 转 角 中 的 误差 响应 曲线 对 比 图 


5 10 15 20 
时 间 /s 
输入 方 波 时 俯仰 角 9 的 误差 响应 曲线 对 比 图 
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时 间 /s 
输入 方 波 时 偏 航 角 由 的 误差 响应 
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图 7 


三 控制 器 在 输入 方 波 时 姿态 角 控制 误差 对 比 


pa 


3.2 改进 LADRC 中 加 入 噪声 扰动 时 的 控制 仿真 实验 


直升机 在 飞行 过 程 中 很 容易 遇 到 外 界 干扰 ， 对 于 直升机 而 


二 证 


i 
声 了 


( I\ /< 
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小 的 干扰 也 可 能 会 造成 很 大 的 飞行 困扰 。 为 了 验 订 
制 器 的 抗 干扰 效果 ， 在 本 文 的 直升机 模型 中 加 入 有 限 带 


上 哩 
呆 砚 占 洲 


F 扰 (band-limited white noise), 将 该 模块 的 参数 设置 为 : 


E 本 文 控 


虹 声 


强度 为 0.01， 采 样 时 间 为 0.01， 发 生 随机 数 的 开始 种 子 为 默认 


化 规律 ， 在 加 入 


输入 阶 跃 响应 和 正弦 信号 。 


秆 23 341， 白 噪声 信号 图 如 图 8 所 示 。 由 于 直升机 在 飞行 过 程 
中 ， 姿 态 角 一 般 按 给 定 的 固定 角度 进行 增 减 变化 ， 故 根 和 


居 此 变 


噪声 干扰 的 基础 上 给 直 于 


参数 设 
扰 下 输入 阶 跃 响应 时 姿态 角 跟 踪 1 
器 对 于 实时 变化 信号 的 
号 In_y=10sin(0.41)rad ， 
为 0.4， 得 到 图 


为 : 延迟 时 间 为 5， 幅 值 为 10， 得 到 图 9， 


机 的 三 姿态 人 


分 别 


首先 输入 阶 跃 响应 ， 并 将 该 模块 的 


噪 j 


线 ， 为 进 


2 本 


kk 体 的 参数 设置 为 幅 


值 为 10， 这 


步 验证 本 文 控制 
空 制 效果 ， 给 直升机 姿态 角 输 入 正弦 信 


频率 


10， 


踪 


速度 ， 所 加 入 的 扰动 并 没有 给 直升机 的 姿态 角 角 度 的 控 人 
明显 的 影响 , 由 图 


线 及 跟踪 误差 响应 曲线 。 


图 9 可 以 看 出 ， 在 白 噪声 干扰 下 的 姿态 人 


白 噪声 干扰 下 输入 正弦 信号 时 姿态 角 


的 跟 


很 快 的 响应 


判 带 来 


10 可 以 看 出 , 在 白 噪声 干扰 


对 于 正 5 


线 


的 跟踪 效果 良好 , 跟踪 的 总 误差 能 够 保持 在 土 4” 以 内 , 总体 而 
言 ， 本 文 控制 器 在 噪声 扰动 下 的 姿态 角 跟踪 既 具 有 快速 性 ， 又 
具有 准确 性 与 稳定 性 。 


有 限 带 宽 白 噪声 信号 显示 图 
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图 8 有 限 带 宽 白 噪声 干扰 显示 图 
了 白 噪声 干扰 下 输入 阶 跃 响 应 时 姿态 角 角 度 的 变化 曲线 
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到 9 白 噪 声 干 扰 下 输入 阶 跃 响应 时 姿态 角 跟 踩 
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姿态 角 误 差 响应 曲线 


白 噪 声 十 扰 下 输入 正弦 信号 响应 曲线 5 


20 一 一 实际 变化 曲线 一 一 设 定 的 正弦 曲线 
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图 10 白 品 声 干扰 下 输入 正 强 


跟踪 曲线 及 误差 响应 曲线 


言 号 时 姿态 


4 ”结束 语 


无 人 直升机 是 多 输入 多 输出 、 强 耦合 、 非 线性 强 的 六 自 
度 刚 体 , 本 文 根 据 亚 拓 600 无 人 直升机 自身 的 结构 与 飞行 特性 ， 
建立 其 动力 学 模型 。 本 文 提出 的 改进 LADRC 中 加 入 了 跟踪 微 
分 器 ， 并 改进 了 控制 器 连接 结构 与 反馈 补偿 系数 。 改 进 后 的 线 
性 自 抗 扰 控制 器 结构 相对 简单 ， 算 法 清晰 。 最 后 在 
MATLAB/simulink 环境 中 搭建 直升机 模型 与 控制 系统 ， 通 过 给 
定 三 个 姿态 角 固 定 的 角度 信号 及 方 波 信 号 ， 将 改进 前 的 
LADRC、 本 文 提出 的 改进 的 LADRC 与 模糊 PID 控制 器 的 控制 
方法 分 别 应 用 于 直升机 的 姿态 角 控 制 中 。 对 比 三 控制 器 的 控制 
结果 发 现 ， 在 本 文 控制 器 的 控制 下 ， 姿 态 角 响应 速度 更 快 ， 稳 
定性 更 好 ;， 此 外 ， 在 白 噪声 干扰 下 ， 本 文 控 制 器 也 能 对 指定 的 
阶 跃 信 号 及 正弦 信号 快速 作出 响应 ,不 仅 有 较 高 的 跟踪 准确 性 
也 具有 良好 的 抗 干扰 性 能 。 
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